/*
 * Copyright (c) 2012 Travis Geiselbrecht
 *
 * Use of this source code is governed by a MIT-style
 * license that can be found in the LICENSE file or at
 * https://opensource.org/licenses/MIT
 */
#include <lk/debug.h>
#include <assert.h>
#include <dev/gpio.h>
#include <platform/imxrt.h>
#include <platform/gpio.h>
#include <fsl_common.h>
#include <fsl_gpio.h>


typedef GPIO_Type imxrt_gpio_t;

static imxrt_gpio_t *port_to_pointer(unsigned int port) {
    switch (port) {
        default:
        case GPIO_PORT_0:
		case GPIO_PORT_4:
            return (imxrt_gpio_t *)0;
        case GPIO_PORT_1:
            return GPIO1;
        case GPIO_PORT_2:
            return GPIO2;
        case GPIO_PORT_3:
            return GPIO3;
        case GPIO_PORT_5:
            return GPIO5;
    }
}

static void enable_port(unsigned int port) {

}

void imxrt_gpio_early_init(void) {

}

int gpio_config(unsigned nr, unsigned flags) {

    uint port = GPIO_PORT(nr);
    uint pin = GPIO_PIN(nr);
	uint config = SPEED_100MHZ | DSE_R0;
	gpio_pin_config_t gpio_config;
	
    enable_port(port);


    if (flags & GPIO_INPUT) {
        gpio_config.direction = kGPIO_DigitalInput;
    } else if  (flags & GPIO_OUTPUT) {
        gpio_config.direction = kGPIO_DigitalOutput;
    }

    if (flags & GPIO_PULLUP) {
        config |= PULLUP_47K;
    } else if (flags & GPIO_PULLDOWN) {
        config |= PULLDOWN_100K;
    }

    if (flags & GPIO_IMXRT_OD) {
        config |= OD_EN;
    } else {
        config |= PULL_EN;
    }
	
	gpio_config.interruptMode = (gpio_interrupt_mode_t)kGPIO_NoIntmode;

    imxrt_iomuxc_pinconf(pin, ALT5, config);

    GPIO_PinInit(port_to_pointer(port), pin, &gpio_config);


    return 0;
}

void gpio_set(unsigned nr, unsigned on) {
	if(on)
		GPIO_SetPinsOutput(port_to_pointer(GPIO_PORT(nr)), 1 << GPIO_PIN(nr));
	else
		GPIO_ClearPinsOutput(port_to_pointer(GPIO_PORT(nr)), 1 << GPIO_PIN(nr));
}

int gpio_get(unsigned nr) {
    return GPIO_PinRead(port_to_pointer(GPIO_PORT(nr)), GPIO_PIN(nr));
}

